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Abstract 


The  acceleration  set  theory  developed  in  the  companion  report  is  applied  to  two  important 
problems  which  arise  in  the  design  of  manipulator  systems  for  performance:  manipulator  type 
selection  and  actuator  size  determination.  A  systematic  procedure  is  given  for  the  comparison  of 
the  performance,  based  on  acceleration,  of  a  set  of  alternative  manipulator  types.  This  procedure  is 
then  used  to  compare  the  performance  of  three  well-known  manipulator  designs  which  have  been 
proposed  for  high  performance.  Simple  algOTithms,  based  on  the  acceleration  set  theory,  are  given 
for  the  determination  of  the  minimum  actuator  sizes  to  obtain  a  specified  isotropic  acceleration. 
The  ease  of  implementation  of  these  algorithms  is  demonstrated  by  actual  examples.  The 
experimental  determination  of  acceleration  sets  is  also  addressed  and  simple  experimental  results 
are  presented  and  compared  with  those  predicted  by  the  theory. 


1  bitroduction* 


In  this  paper,  we  apply  the  acceleratioo  set  theory  developed  in  (Desa  and  Kim.  1989)  to  the  following 
two  important  problems  which  arise  in  the  design  of  manipulator  systems: 

1.  The  selection  of  manipulator  type  from  a  given  set  of  feasible  alternatives. 

2.  The  determination  of  the  acrrator  sizes  for  a  given  manipulator  type. 

One  approach  to  solving  the  above  two  problems  is  to  define  suitable  performance  measures.  These 
performance  measures  could  then  be  used  as  a  basis  for  comparing  different  manipulator  types  in  order 
to  selea  the  “best”  one.  Funhetmoie,  if  the  performance  measures  could  be  explicitly  related  to  the  input 
design  variables  of  the  problem,  for  example  actuator  size,  then  we  could  use  these  measures  to  obtain 
values  C'sizes”)  of  the  design  variables  to  meet  a  desired  level  of  performance. 

In  this  paper,  we  show  how  acceleration  properties  of  the  acceleration  sets,  when  interpreted  as 
performance  measures  can  be  used  to  provide  solutions  to  the  "  manipulator  type  selection”  problem  and 
the  “  aauator  sizing”  problem  state  above. 

Several  performance  measures  for  manipulators  have  been  proposed  in  earlier  studies  (Asada,  1983; 
Yoshikawa,  198S;  Khatib  and  Burdick,  1987;  Graettinger  and  Krogh;  1988)  and  it  is  useful  to  briefly 
discuss  these  performance  measures  within  the  present  context.  (Asada,  1983)  has  defined  a  General  Inertia 
Ellipsoid  (GIE)  to  characterize  manipulator  dynamics;  this  measure  does  not  have  a  clear  physical  meaning 
and  is  mostly  useful  in  those  cases  where  the  nonlinearities  in  the  joint  velocities  are  zero.  (Yoshikawa, 
1985)  defines  a  dynamic  manipulability  index  which  is  essentially  based  on  the  linear  mapping  between  the 
actuator  torques  and  end-effector  acceleration  and  therefore  does  not  take  into  account  the  nonlincarities  in 
joint  velocities.  (Khatib  and  Burdick,  1987)  define  a  performance  measure  whose  physical  meaning  is  not 
clear  and  which,  in  addition,  accounts  for  the  nonlinearities  in  a  somewhat  ad-hoc  fashion  by  evaluating 
the  measure  at  one  “high”  and  one  “low”  joint  velocity  vector.  These  drawbacks  have  been  pointed  out  in 
(Graeninger  and  Krogh,  1988)  who  propose  an  acceleration  radius,  which  in  the  terminology  of  (Khatib 
and  Burdick,  1987)  or  (Desa  and  Kim,  1989)  is  the  isotropic  acceleration  over  an  operating  region  and  can 

be  thought  of  as  a  “global  isotropic  acceleration”.  Since  the  isotropic  acceleration  does  not  always  exist 
and  is  zero  at  a  singular  point,  global  isotropic  acceleration  (acceleration  radius)  will  in  general  be  zero 


*  Equation  (1.x)  refers  to  equation  (1  .x)  in  Part  I  (i.c.  (Desa  and  Kim,  1989)).  Every  equation  in  the  cunent  paper 
(i.e.  Partll)  starts  with  "2.",  for  example  (2.46). 
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unless  the  operating  region  is  small  enough,  in  which  case  it  approaches  the  local  isotropic  acceleration, 
one  of  the  meastires  proposed  in  the  current  paper.  Furthermore,  designing  for  global  isotropic  acceleration 
(acceleration  radius)  when  possible  will  result  in  actuators  which  are  grossly  oversized. 

In  section  3.  we  propose  a  group  of  performance  measures  of  increasing  complexity,  based  on  the 
theory  developed  in  the  companion  paper,  (Desa  and  Kim,  1989),  which  are  attractive  for  the  following 
reasons: 

1.  They  have  simple  physical  meanings. 

2.  They  can  be  directly  related  to  the  manipulator  parameters  and  input  variable  rates  (actuator  torques, 
joint  variables)  and  therefore  can  be  used  for  design  and  redesign. 

3.  The  most  “  complex”  performance  measure,  the  local  isotropic  acceleration  takes  nonlinearities  into 
account  in  an  “exact”  maruter. 

A  direct  consequence  of  (2)  and  (3)  is  that  a  typical  design  problem  like  the  determirtation  of  actuator 
sizes  to  guarantee  a  specified  isotropic  acceleration  can  be  solved  in  a  relatively  straightforward  manner 
and  without  resort  to  complex  nonlinear  optimization  as  in  (Graettinger  and  Krogh,  1988). 

The  paper  is  organized  as  follows:  In  section  2,  we  present  a  heuristic  justification  for  using  accelera¬ 
tion  (and  acceleration  properties)  as  a  measure  of  dynamic  performance  for  manipulators.  Several  useful 
acceleration-based  performance  measures  are  then  defined  in  section  3.  These  performance  measures  are 
then  used  to  solve  the  “manipulator  type  selection”  problem  in  section  4  and  to  solve  the  “actuator  sizing” 
problem  in  section  5. 

The  experimental  determination  of  acceleration  sets  is  described  in  section  6.  The  simple  experimental 
results  presented  in  this  section  serve  to  validate  the  theory  presented  in  the  companion  paper. 

2  Dynamic  performance 

Dynamic  systems  are  designed  to  perform  a  variety  of  tasks.  Each  task  generally  has  an  inherent  measure 
of  its  performance  which  we  will  refer  to  as  the  task  performance  measure.  For  example,  if  the  dynamic 
system  is  a  manipulator  and  the  task  is  for  a  reference  point  P  to  move  from  one  point  to  another,  then 
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Figure  1:  Performance  measures  for  manipulators 


the  time  t  required  to  perform  this  task  is  a  measure  of  how  well  the  manipulator  performs  the  task  and  is 
therefore  an  appropriate  task  performance  measure.  (We  would,  of  course,  like  to  minimize  the  time  r.) 

The  performance  measures  used  to  characterize  a  dynamic  system,  on  the  other  hand,  arc  quantities 
which  one  can  readily  extract  from  the  dynamical  equations  describing  the  behavior  of  the  system;  we  will 
refer  to  these  performance  measures  as  the  dynamic-system  performance  measures.  In  general,  explicit 
functional  relations  do  not  exist  between  the  task  performance  measures  and  dynamic  system  performance 
measures. 

In  the  above  example  of  the  manipulator  as  a  dynamic  system  with  the  task  being  to  move  the 
reference  point  P  from  one  point  in  the  workspace  to  another,  the  time  t  requited  to  perform  this  task 
(task  performance  measure)  carmot  be  readily  extracted  from  the  dynamical  equations.  However,  as  we 
have  shown,  the  acceleration  capability  of  the  manipulator  (as  defined  in  section  3  of  (Desa  and  Kim, 
1989))  can  be  extracted  from  the  dynamical  equations  (as  shown  in  sections  4  and  5  of  (Desa  anu  Kim, 
1989)).  For  a  dynamic  system  performance  measure  to  be  useful,  it  should  be  related  at  least  implicitly 
to  the  task  performance  measure.  It  is  well  known,  from  computer  generated  numerical  solutions  of  the 
problem  (Bobrow,  Dubowsky  and  Gibson,  1985),  that  the  time  required  to  move  a  reference  point  P  of 
the  manipulator  from  one  point  in  the  workspace  to  another  depends  on  the  “acceleration  capability”  of 
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the  manipulator  if  one  “improves"  the  acceleration  capability  of  a  manipulator,  then  the  time  required  to 
perform  the  task  is  reduced.  Therefore,  the  “acceleration  capability”  of  a  manipulator  is  a  useful  dynamic 
system  performance  measure. 

Specifically,  we  use  two  properties  of  the  acceleration  sets  (or  acceleration  capability)  as  dynamic 
system  performance  measures:  the  maximum  acceleration  and  the  isotropic  acceleration.  Furthermore, 
we  are  generally  interested  in  these  performance  measures  under  three  operating  conditions,  start-up,  in¬ 
motion,  and  local,  which  are  defined  below.  Figure  1  depicts  the  view  of  tasks  and  performance  measures 
for  mam'pulators  presented  in  this  chapter. 

Comments: 

1.  The  reason  for  defining  three  types  of  operating  conditions  is  that  the  start-up  condition  is  easier  to 
design  for  than  the  in-motion  condition  which  in  turn  is  easier  to  design  for  than  the  local  operating 
condition.  Therefore,  the  start-up  condition  can  be  used  to  obtain  very  quick  approximate  results 
which  can  then  be  refined  for  other  operating  conditions  (see  section  6). 

2.  The  isotropic  acceleration  is  a  measure  of  the  ability  of  the  manipulator  to  accelerate  in  all  directions 
and  can  be  thought  of  as  a  measure  of  the  manuverability  of  the  manipulator  (Graettinger  and  Krogh, 
1988}  or  its  ability  to  avoid  obstacles. 

3  Performance  measures 

3.1  Start-up  acceleration  capability 

Definition:  The  start-up  acceleration  capability  of  a  manipulator,  corresponding  to  a  given  configuration 
q  in  the  workspace,  is  the  set  of  all  available  acceleration  vectors  of  a  reference  point  P  when  the 
mam'pulator  is  at  rest  and  input  torques  ri  and  tz  are  applied  at  the  (driven)  joints. 

From  the  above  definition,  it  is  clear  that  the  start-up  acceleration  capability  as  defined  above  is  simply 
the  acceleration  set  5r,  which  is  given  by  equations  (1.34). 
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32  In>motion  acceleration  capability 

Definition  1:  The  in-motion  acceleration  capability  of  a  manipulator  is  the  set  of  all  available  acceleration 
vectors  of  a  reference  point  P  when  the  point  P  is  moving  with  a  velocity  iF  ala.  given  position  xP 
in  the  workspace. 

When  the  point  /*  is  at  a  position  xP  with  a  velocity  xP, 

1.  the  corresponding  configuration  q  of  the  manipulator  can  be  obtained  from  xP  by  solving  the  inverse 
kinematic  problem  (Desa  and  Roth,  1985),  and 

2.  the  corresponding  joint  variable  rate  veaor  q  can  (except  for  a  certain  finite  number  of  singular 
positions)  be  obtained  from  equation  (1.22)  as 

4  =  r‘x'’.  (2.1) 

We  can  therefore  restate  Definition  1  in  the  following  equivalent  form: 

Definition  2:  The  in-motion  acceleration  capability  of  a  manipulator  is  the  set  of  all  available  acceleration 
vectors  of  a  reference  point  P  when  the  manipulator  is  in  the  dynamic  state  u  =  (q,  q)  and  the 
actuator  torques  r\  and  vi  are  applied  at  the  driven  joints. 

From  the  above  definition,  it  is  clear  that  the  in-motion  acceleration  capability  of  the  manipulator  as 
defined  above  is  simply  the  state  acceleration  set  5u,  which  is  given  by  equations  (1.39). 

33  Definition  of  performance  measures 

In  order  to  be  able  to  design  a  manipulator  to  have  desirable  acceleration  capability,  we  need  to  be 
able  to  extract  suitable  performance  measures.  Six  such  measures  are  defined  below:  the  first  two 
characterize  the  acceleration  capability  at  start-up,  the  next  two  characterize  the  acceleration  capability 
when  the  manipulator  is  in  motion,  and  the  last  two  characterize  the  (local)  acceleration  capability  at  any 
configuration  in  the  workspace.  It  should  come  as  no  surprise  that  the  performance  measures  as  defined 
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below  are  the  propeities  of  the  acceleration  sets  detennined  in  section  5  of  the  companion  paper  (Desa 
and  Kim,  1989). 

1.  Maximum  start-up  acceleration,  a,..  „ 

Definition:  The  maximum  start-up  acceleration  Om..  ^  is  the  maximiun  available  acceleration  of  a  ref¬ 
erence  point  P  when  the  manipulator  is  at  rest  and  (input)  torques  ri  and  are  applied  at  the 
joints. 

From  the  above  definition,  it  is  clear  that  the  maximum  start-up  acceleration  is  given  by 

4DU,ni  ~  OxatxiSr)  —  niax[fl(ST)],  (2.2) 

where  flm*x(-ST )  is  given  by  equation  (1.69). 

2.  Isotropic  start-up  acceleration,  ni^.w 

Definition:  The  isotropic  start-up  acceleration  OiM,  n  is  the  maximum  available  acceleration  in  all  direc¬ 
tions  of  a  reference  point  P  when  the  manipulator  is  at  rest  in  a  configuration  q  and  (input)  torques 
Tj  and  ri  are  applied  at  the  joints. 

From  the  above  definition,  it  is  clear  that  the  isotropic  start-up  acceleration  is  given  by 
t^i0,su  ”  <^i»o('^T),  (2.3) 

where  ai,o(Sr)  is  given  by  equation  (1.70). 

3.  Maximum  "in-motion”  acceleration,  OmtxM 

Definition  1:  The  maximum  “in-motion”  acceleration  of  a  manipulator  is  the  maximum  available  accel¬ 
eration  when  the  reference  point  P  moves  with  a  velocity  x^  at  a  position  x^  in  the  workspace. 

An  equivalent  definition  for  flmix.im  is  the  followbg: 

Definition  2:  The  maximum  "in-motion”  acceleration  of  a  manipulator  is  the  maximum  available  accel¬ 
eration  of  a  reference  point  P  when  the  manipulator  is  in  a  dynamic  state  u  and  actuator  torques  rj 
and  T2  are  applied  at  the  joints. 


From  the  above  definition,  it  is  clear  that  the  maximum  “in-motion”  acceleration  is  given  by 
dmu,im  “  “  tttax[fl(5u)],  (2.4) 

where  OmaxC^u)  is  given  by  equation  (1.130). 

4.  Isotropic  “in-motion”acceIeration,  niscim 

Definition  1:  The  isotropic  “in-motion”  acceleration  of  a  manipulator  is  the  maximum  available  accel¬ 
eration  in  all  directions  when  the  reference  point  P  moves  with  a  velocity  at  a  position  and 
torques  are  applied  at  the  driven  joints. 

An  equivalent  definition  for  aito,im  is  the  following: 

Definition  2:  The  isotropic  “in-motion”  acceleration  of  a  manipulator  is  the  maximum  available  accel¬ 
eration  of  a  reference  point  P  in  all  directions  when  the  manipulator  is  in  a  dynamic  state  u  and 
torques  n  and  rj  are  applied  at  the  driven  joints. 

From  the  definition  above,  it  is  clear  that  the  isotropic  in-motion  acceleration  is  given  by 
Oiio.im  ~  <tiio(5u)i  (2.5) 

where  ni,o(^u)  is  given  by  equation  (1.133). 

5.  Maximum  local  acceleration,  Omujoui 

Definition:  The  maximum  local  acceleration  Om,,,  jocii  of  a  manipulator  is  the  maximum  available  accel¬ 
eration  of  the  reference  point  P  at  a  configuration  q  of  the  manipulator. 

The  maximum  local  acceleration  flmix,ioc«i  is  bounded  by  the  upper  bound  (am»x,ioc*i)ub  given  by  (1.151) 
and  the  lower  bound  (Omix.iocxi)/*  given  by  (1.130)  with  the  vector  k  evaluated  at  the  joint  variable  vector 
q  which  maximizes  qi)  in  equation  (1.89). 

6.  Isotropic  local  acceleration,  ni,o.iocai 
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Definition:  The  isotropic  local  acceleration  a;.»  w.i  of  a  manipulator  is  the  maximum  available  acceler¬ 
ation  of  the  reference  point  P  in  all  directions  when  the  manipulator  is  at  the  (local)  configuration 
q  in  the  workspace. 

The  isotropic  local  acceleration  Ouo, local  is  given  by  equation  (1.1S2). 

3.4  Uses  of  the  acceleration  measures 

The  six  acceleration  measures  can  be  used  for  the  following  purposes: 

1.  To  compare  different  manipulator  types  in  order  to  select  a  manipulator  type  with  the  “best”  accel¬ 
eration  capabilities. 

2.  To  design  a  manipulator  to  yield  certain  specified  acceleration  properties. 

3.  To  redesign  a  given  manipulator  in  order  to  improve  its  acceleration  properties. 

4.  To  yield  estimates  of  the  inertia  forces  which  can  then  be  used  to  size  the  links  in  very  “high- 
performance”  applications. 

In  the  next  two  sections,  we  demonstrate  the  first  two  uses  of  the  acceleration  measures.  In  section 

4,  we  also  address  simple  redesign,  i.e.,  performance  improvement  by  changing  actuator  size. 

Comment: 

Since  the  isotropic  acceleration  is  a  measure  which,  by  definition,  is  “direction-invariant”,  it  is  a  more 

useful  measure  for  the  solution  of  problems  1  and  2. 
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4  Selection  of  manipulator  type 

After  defining  the  manipulator  type  selection  problem,  we  present  a  procedure  for  its  solution  (section  4.2). 
This  procedure  is  applied  in  section  4.3  to  three  popular  manipulator  types  which  have  been  proposed  for 
“high  performance”. 

4.1  Definition  of  the  problem 
General  problem  statement 

Given  a  set  of  alternate  manipulator  types,  select  the  manipulator  type  which  yields  the  best  perfor¬ 
mance. 

In  section  S.l  and  S.2,  we  established  the  use  of  acceleration  and  acceleration  properties  as  measures 
of  performance.  We  can  therefore  restate  the  above  general  problem  statement  in  a  more  precise  manner 
for  our  purposes  as  follows; 

Specific  problem  statement 

Given  a  set  of  alternative  manipulator  types,  select  the  manipulator  type  which  yields  the  largest 
isotropic  acceleration  imder  various  operating  conditions  (start-up,  in-motion  and  local). 

4.2  Procedure  for  type  selection 

1.  Determine  the  geometric  and  inertia  parameters  for  each  manipulator  type. 

2.  Determine  the  ranges  for  the  inputs,  q  and  r,  of  each  manipulator  type. 

3.  Determine  the  acceleration  sets  Sr,  S^^  and  5u  for  each  manipulator  type.  (We  did  this  in  section  4 
of  Part  I  (Desa  and  Kim,  1989)  for  the  planar  two  degree-of-freedom  manipulator  of  Figine  4.) 

4.  Extraa  the  isotropic  acceleration  for  the  sets  5r.  S^^  and  5u  (using  the  theory  developed  in  section 
5  in  Part  I  (Desa  and  Kim,  1989)). 
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Figure  2:  Manipulator  type  2  (from  Asada  and  Youcef-Touml,  1985) 

5.  Obtain  the  isotropic  acceleration  for  each  manipulator  type  tmder  various  operating  conditions 
(start-up,  in-motion  and  local)  using  (1.70),  (1.133)  and  (1.152). 

6.  The  “best”  manipulator  type  is  the  one  which  has  the  largest  isotropic  acceleration  under  the  various 
operating  conditions  for  the  configuration  (q)  of  interest. 

7.  Critically  examine  the  possibility  of  redesigning  each  manipulator  type  and  then  repeat  steps  1 
through  6  for  the  redesigned  manipulator. 

8.  Perform  stepsl  through  7  for  various  configurations  (q)  of  interest 
43  Example 

As  an  illustration  of  the  above  procedure,  we  compare  the  performance  of  the  three  manipulator  types 
shown  in  Figure  8  (Asada  and  Kanade,  1983),  Figure  2  (Asada  and  Youcef-Toumi,  1985)  and  Figure  3 
(Newman,  1988),  which  will  be  referred  to,  respectively,  as  manipulator  type  1,  manipulator  type  2  and 
manipulator  type  3.  Manipulator  type  1  was  the  original  direct  drive  manipulator.  Manipulator  type  2 
in  which  both  actuators  are  mounted  at  the  base  was  proposed  in  order  to  improve  the  performance  of 
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Figures:  Manipulator  type  3  (from  Newman,  1987) 

manipulator  type  1;  note  that  this  manipulator  type  has  a  “closed  kinematic  chain".  Later  manipulator  type 
3  was  proposed  in  order  to  improve  the  performance  of  manipulator  type  2.  The  parameters  and  variables 
for  manipulator  types  1,  2  and  3  are  given,  respectively,  in  Figure  4.  Hgure  S  and  Figure  6.  (Note  that 
the  joint  variable  q2  for  manipulator  type  1  is  differait  from  the  joint  variable  qi  for  manipulator  type  2). 


The  dynamic  equations  for  each  manipulator  type  are  given  in  Appendix  A  and  were  used  to  determine 
and  extract  the  properties  of  the  acceleration  sets  5r.  and  Su  using  the  theory  developed  in  (Desa  and 
Kim.  1989).  The  maximum  and  isotropic  acceleration  under  the  three  operating  conditions  are  then 
determined. 

The  numerical  values  of  the  link  parameters  for  each  manipulator  type  are  given  in  Table  1.  Two 
identical  actuators,  with  maximum  torques  and  of  30  Nm  were  used.  The  input  torque  set  is  given 
by 

7*=  {t1  I  Ti  1<  30.0  Nm,  i  =  1,2}  (2.6) 


and  the  set  of  joint  variable  rates  given  by 
^={41  U.  |<5.0rad/s,  f  =  l,2}. 


II 


(2.7) 


Figure  4:  Parameters  and  variables  of  manipulator  type  1 
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Parameters  and  variables  for  manipulator  type  2 


Table  1:  Initial  design  parameters  of  manipulator  types  1,  2  and  3 
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Operating 

condition 

Q}nfiguration 

q  =  (<7i.  <ft) 

Isotropic  acceleration,  Ouo  m/s^ 

manipulator  type  1 

manipulator  type  2  manipulator  type  3 

Start-up 

(0®.  45°) 

24.4 

21.5 

21.1 

(0®,  90®) 

26.9 

27.8 

28.5 

In-motion 

(0®.  45®) 

20.8 

5.14 

8.83 

(^1  =  5  r/s,  ^  =  -5  r/s) 

Local 

(0®,  45®) 

5.74 

5.14 

8.83 

Tabic  2:  Isotropic  acceleration  of  the  initial  design  of  three  manipulator  types 

Each  link  of  all  the  three  manipulator  types  was  chosen  to  be  the  same.  The  weight  of  the  second  actuator 
Ti  (mounted  on  the  second  link)  causes  the  values  of  ai  and  mi  for  link  1  of  manipulator  type  1  to  be 
different  from  the  corresponding  values  of  link  1  for  the  other  manipulator  types. 

The  results  obtained  for  isotropic  acceleration  for  the  initial  design  arc  given,  respectively,  in  Table 
2.  (Note  that  the  start-up  accelerations  were  computed  for  two  different  configurations). 

Let  us  now  examine  the  possibility  of  performance  improvement  by  increasing  the  actuator  size  of  the 
two  actuators.  Increasing  the  size  of  actuator  2  (t2)  for  manipulator  type  1  will  have  an  adverse  effect  on 
its  performance  because  the  additional  weight  of  the  second  actuator  will  be  an  additional  inertial  “load” 
on  the  first  actuator.  So,  it  is  not  advisable  to  increase  the  size  of  the  second  actuator.  Furthermore,  in 
the  present  example  it  is  the  size  of  actuator  1  which  determines  the  isotropic  acceleration  and  increasing 
the  size  of  the  first  actuator  alone  will  not  change  the  isotropic  acceleration  (see  section  S.S).  Therefore, 
manipulator  type  1  is  not  a  good  candidate  for  redesign.  The  actuator  sizes  of  both  actuators  can  be 
readily  increased  for  manipulator  types  2  and  3  since  both  actuators  (for  each  of  these  types)  are  mounted 
at  the  base.  We  will  therefore  consider  the  effects  of  doubling  the  size  of  both  actuators  of  manipulator 
types  2  and  3.  The  results  obtained  for  the  isotropic  acceleration  for  the  redesigned  manipulator  types  2 
and  3  are  given  in  Table  3. 

From  the  results  of  Table  2  and  Table  3,  we  can  draw  the  following  condition. 
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Operating 

Configuration 

Isotropic  acceleration,  Oao  Qi/s^ 

condition 

q  =  (<7t.  <n) 

manipulator  type  2 

manipulator  type  3 

Start-up 

(0“.  45“) 

43.0 

42.2 

(0“.  90°) 

55.6 

57.0 

lo-motion 

(0°.  45°) 

10.2 

17.6 

(^1  =  5  r/s,  qi  =  -5  r/s) 

Local 

(0°.  45°) 

10.2 

17.6 

Table  3:  Isotropic  acceleration  of  the  redesigned  manipulator  types  2  and  3 

1.  Based  on  the  local  isotropic  acceleration  (which  takes  the  nonlinearities  into  account)  of  the  initial 
design  (Table  2),  the  manipulator  type  3  is  “better**  than  the  manipulator  type  1  which  slightly  better 
than  manipu.itor  type  2. 

2.  When  we  take  advantage  of  the  faa  that  manipulator  types  2  and  3  can  be  redesigned,  we  sec  that 
(based  on  local  isotropic  acceleration  in  Table  3)  manipulator  type  3  is  better  than  manipultor  type 
2  which  is  better  than  (the  initial)  manipulator  type  1. 

These  conclusions  are  borne  out  in  practice:  it  is  well-known  that  manipulator  type  3  is  “faster”  than 
manipulator  type  2  which  in  turn  is  much  “faster”  than  manipulator  type  1.  (The  reason  manipulator 
types  2  and  3  are  better  than  manipulator  type  1  is  because  they  both  have  all  their  actuators  mounted 
at  the  base.  The  reason  manipulator  type  3  is  better  than  manipulator  type  2  is  because  the  “steel-belt** 
used  in  manipulator  type  3  to  transmit  the  torque  from  the  base  actuator  to  the  second  link  has  negligible 
inertia  compared  to  the  linkages  used  in  manipulator  type  2  to  transmit  the  torque  from  the  base  acmator 
to  the  second  link.) 
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5  Determination  of  the  actuator  size  for  isotropic  acceleration 


In  this  section,  we  demonstrate  how  the  theory  developed  in  (Desa  and  Kim,  1989)  can  be  used  to  solve 
the  “actuator  size  determination”  problem  in  a  relatively  straightforward  fashion. 

5.1  Introduction 

Given  a  manipulator  at  a  configuration  q  in  the  workspace  with  specified  geometric  (i.e.,  link  lengths, 
etc.)  and  inertia  parameters  (i.e.,  masses,  moment  of  inertias,  etc.),  and  specified  workspace  and  joint 
variable  rate  constraints,  determine  the  actuator  torques  required  to  yield  a  specified  (desired)  acceleration 
property  (for  example,  a  specified  local  isotropic  acceleration). 

52  Definition  of  the  problem 
Definitions 

rjj  =  input  parametci  (cr  variable):  the  input  parameters  are  the  geometric  and  the  inertia  parameters. 

V  =  [A,  h,  ui.  ozi  mz,  A,  Izf  input  parameter  vector  with  /*  component  rjj. 

W  :  workspace  of  the  manipulator. 

F  :  Joint  rate  variable  set. 

T  :  torque  set. 

a  :  some  specified  acceleration  property  under  a  given  operation  condition  (start-up,  in-motion,  local), 
for  example,  Oi,o,w 


Problem  statement 

Given  the  input  vector  rj  of  link  parameters  and  the  constraint  sets 
W'=  {qki  <  <  <liu,  »=  1,2} 
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and 


{q|  I  Qi  l<  »=  1.2}, 

detennine  the  torque  set 

7”=  {r  1  I  r,-  |<  Tio,i  =  1,2} 

to  yield  the  specified  acceleration  a.  The  required  actuator  sizes  are  of  course  and 
53  Solution  procedure 

We  distinguish  two  cases,  the  first  \s*ere  the  manipulator  parameter  veaor  t)  is  independent  of  the  weight 
of  the  actuators  and  therefore  of  t\o  and  and  the  second  where  t)  depends  on  the  actuator  weights  and 
therefore  on  and 

In  each  case  we  will  obtain  the  actuator  sizes  to  yield  a  desired  isotropic  acceleration  under  the  three 
operating  conditions. 

Case  1:  Manipulator  parameter  veaor  ij  is  independent  of  the  aauator  sizes  t\o  and 
1  (a)  Determination  of  actuator  sizes  for  specified  start-up  isotropic  acceleration 
Given  a  specified  manipulator  parameter  vector  jj,  determine  actuator  sizes  rio  and  t2o  to  yield  a  spec¬ 
ified  start-up  isotropic  acceleration  „  at  a  given  configuration  q  in  the  wodcspace  of  the  manipulator, 
i.e.,  detennine  and  such  that 

^iio.ni  ^  (2.8) 


The  minimum  actuator  sizes  rio,niin  and  required  to  satisfy  the  requirements  (2.8)  are  given  by 

(2.9) 

(2.10) 


I  dct(>l)  I 


I  del(A)  I 
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Proof:  Equation  (1.70)  expresses  the  isotropic  start-up  acceleration  in  terms  of  the  actuator  torques  ri^ 
and  7^.  Equation  (1.70)  is  equivalent  to  the  following  two  conditions 
I  dct(A)  I  ri^  ^ 

- /■—  —  ■  >  flifo,iu  (2.11) 

I  dct(A)  ^ 

— /  >  fliw.iii-  (2.12) 

Combining  equations  (2.8)  (2.11)  (2.12),  we  obtain 
I  det(A)  I  rio 


det(A)  I  T2a 


—  ^iso.fu 


(2.13) 

(2.14) 


For  a  given  matrix  A  (i.e.,  for  given  aij  and  det(A).  the  actuator  size  t\o  will  be  a  minimum  when  equation 
(2.13)  is  an  equality.  Denoting  by  t\o^  the  value  of  ri^  when  (2.13)  is  an  equality  and  solving  (2.13) 
for  rio,min,  we  obuin  the  result  (2.9).  Starting  with  (2.14)  and  reasoning  in  a  similar  fashion,  we  obtain 
the  result  (2.10)  for  T^,mia. 

1  (b)  Determination  of  actuator  sizes  for  specified  in-motion  isotropic  acceleration 
Given  a  specified  manipulator  parameter  vector  tj,  determine  actuator  sizes  and  to  yield  a 
specified  in-motion  isotropic  acceleration  *  given  manipulator  state  u  =  (q,  q),  i.e.,  determine 

Txo  and  Tio  such  that 


(2.15) 


at  u  =  (q, 


The  minimum  actuator  sizes  r-.o  mi,,  and  T^,min  required  to  satisfy  the  requirement  (2.15)  are  given  by 


im  V'QiZ  ^22+  I  Q22^1  -  Q12^2  I 


det(A)  I 


^ito,  iin  ^a?i  +  a^j+  I  <221*1  -  ati*2  I 
■  id^UA)!  • 


(2.16) 


(2.17) 


(Comment:  k\  and  *2  arc  the  components  of  the  vector  k  which  is  defined  in  section  4  of  Part  I  (Desa 
and  Kim,  1989).) 
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Proof:  Equation  (1.133)  expresses  the  isotropic  in-motion  acceleration  in  terms  of  the  actuator  torques 
Tio  and  T2o.  Equation  (1.133)  is  equivalent  to  the  following  two  conditions 


>  Oi 


I  det(A)|rio  -  \a22lc1  -  012^2! 

\/^2  +  ‘*22 
ldet(A)|Taa  -  (021^1  -  an*2(  ..  . 

/  -  i  flifO.im- 

Combining  (2.18)  (2.19)  and  (2.15),  we  obtain 


(2.18) 

(2.19) 


I  det(A)|rio  -  \a22k1  -  ank2\ 

\J <^2  ^ 

I  dct(A)|Tio  -  1^21*1  -  aiil:2| 


(2.20) 

(2.21) 


For  a  given  matrix  A  (i.e.,  for  given  a^  and  det(A)  and  coefficients  k\  and  ki,  the  actuator  size  t\o  will 
be  a  minimum  when  equation  (2.20)  is  an  equality.  Denoting  by  T\o^ra  the  value  of  t\o  when  (2.20)  is 
an  equality  and  solving  (2.20)  for  riomin.  we  obtain  the  result  (2.16).  Starting  with  (2.21)  and  reasoning 
in  a  similar  fashion,  we  obtain  the  result  (2.17)  for  T^,mm. 

1  (c)  Determination  of  actuator  size  for  specified  local  isotropic  acceleration 
Given  a  specified  manipulator  parameter  vector  tj,  determine  actuator  sizes  r\o  and  vio  to  yield  a 
specified  local  isotropic  acceleration  for  a  given  configuration  q,  i.e.,  determine  t\o  and  t2<,  such 
that 


<%to, local  ^  ^ifo, local' 


(2.22) 


The  minimum  actuator  sizes  rio.min  and  T5<,,min  required  to  satisfy  the  requirement  C  22)  are  given  by 

(2.23) 

(2.24) 


Va?2  +  ^2  ' 

“  nrTTT"  f^ifo, local  Pma*(ff(<S'<^),  hyi 


det(A) 


+  0^1 


det(A)  Pnia*(x(^q)»  fc)] 


where  Pmax(x(5q), /,),  (i  =  1,  2)  are  given  by  equation  (1.92)  in  subsection  5.2  of  Part  I  (Desa  and  Kim, 
1989). 
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Proof:  Equation  (1.152)  expresses  the  local  isotropic  acceleration  in  terms  of  the  actuator  torques  rjo  and 
rio.  Equation  (1.152)  is  equivalent  to  the  following  two  conditions 
1  det(A)lri 


|det(A)|7^ 


~  /^m»x(x(‘^q)i  ^l)  ^  ^itojocal 
~  Pin*x(x(5q),  I2)  ~  ^iso.locil- 


(2.25) 

(2.26) 


Combining  (2.25)  (2.26)  and  (2.22),  we  obtain 

■7“*-^-'°  - ii)  >  aUlocd  P-27) 

\/''i2  +  42 

-  „„„(x(S4), fe)  >  (2.28) 

For  a  given  matrix  A  (i.e.,  for  given  aij  and  det(A)  and  pm»x(x(5q),/i)  (given  by  equation  (1.92)  in 
section  3  of  Part  I  (Desa  and  Kim,  1989),  the  actuator  size  will  be  a  minimum  when  equation  (2.27)  is 
an  equality.  Denoting  by  the  value  of  when  (2.27)  is  an  equality  and  solving  (2.27)  for  ri«  min. 
we  obtain  the  result  (2.23).  Starting  with  (2.28)  and  reasoning  in  a  similar  fashion,  we  obtain  the  result 
(2.24)  for  Tio.min- 


Case  2;  Manipulator  parameter  vector  p  is  dependent  on  the  actuator  sizes  r\o  and 


The  algorithm  for  computing  the  actuator  sizes  is  shown  in  Figure  7.  Essentially,  we  should  embed 
"Case  1”  in  a  closed-loop  which  compensates  for  the  fact  that  r?  does  depend  on  ri„  and  t^. 

The  algorithm  (Figure  7)  consists  of  the  following  steps: 

1.  Initialization.  The  initial  parameter  vector  tj  is  computed  based  on  the  actuator  weights  being  set 
to  zero.  The  values  of  the  actuator  sizes,  denoted  by  rio(old)  and  T2o(old),  are  set  to  zero. 

2.  Compute  actuator  sizes  rio(new)  and  rj^fnew)  based  on  a  given  parameter  vector  t;  as  in  Case  1 
(Use  Case  1(a)  for  start-up.  Case  1(b)  for  in-motion  and  Case  1(c)  for  local). 

3.  Check  whether  t\o  and  converge  using  the  following  convergence  criteria 

rio(new)  -  rio(old)  ^ 

- ZoTi -  -  (2.29) 

ri„(old) 
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Figure  7:  Algorithm  for  computation  of  actuator  sizes  to  yield  desired  acceleration 
requirements  for  the  case  where  the  manipulator  parameter  vector  r?  depends  on  the 
actuator  sizes  n,  and  ri^ 
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T^(ncw)  -  T5^(oId)  ^ 

7a4,(old)  -  ** 


(2.30) 


where  fi  md  (2  are  defined  by  the  user.  If  (2J9)  and  (2.30)  are  satisfied,  «  ^^^(new)  and 
r>,mm  s  r2a(new)  and  the  design  is  complete. 

4.  If  (2.29)  and  (2.30)  are  not  satisfied,  update  the  parameter  veaor  rj  based  on  new  actuator  sizes 
rio(new)  and  720(new),  and  go  to  step  2. 

The  closed  loop  shown  in  Figure  7  essentially  performs  iterations  of  step  2,  3,  and  4  till  the  convergence 
criteria  are  satisfied. 

Comment: 

The  “start-up"  case  can  be  used  to  get  a  quick  design  which  can  be  successively  refined  by  doing  the 
"in-motion  case"  and  “local  case".  This  is  demonstrated  in  the  example  below. 

5.4  Example: 

Determination  of  actuator  sizes  for  acceleration  properties  for  a  two  degree-of-freedom  serial  planar 
manipulator. 

We  illustrate  how  we  determine  the  minimum  actuator  sizes  of  a  planar  two  degree-of-freedom  ma¬ 
nipulator  built  in  our  laboratory  for  the  following  three  cases 

Case  1:  (Start-up)  fl„o,iu  =  3  m/s^  at  (^1  =0®,  92  =  90®) 

Case  2:  (In-motion)  fliso.im  =  3  m/s^  at  (^1  =  0®,  ^2  *  90®,  =  Irad/s^,  ^  =  Irad/s*) 

Case  3:  (Local)  ai,o.io«ai  =  3  m/s^  at  (^j  =  0®,  qj  =  90®) 

Initialization 

Initial  link  parameters  for  links  1  and  2  are  as  follows: 

link  1:  fj  =  0.303  m,  a\  =  0.088  m,  mi  «  1.126  Kg,  /j  =  0.103  Kg  m^, 
link  2:  h  =  0.254  m.  02  =  0.094  m.  m2  =  1.120  Kg.  h  =  0.003  Kg  m^. 
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Since  our  manipulator  belongs  to  manipulator  type  1  in  section  4.  we  use  the  loop-algorithm  in  Case  2. 


Case  1:  Design  for  start-up  acceleration 

To  give  the  reader  a  feel  for  how  to  size  actuators  using  the  algorithm,  we  include  the  results  of  the 
three  iterations  which  were  needed  to  obtain  the  aauator  sizes. 

Iteration  1. 

Using  equations  (2.9)  and  (2.10)  with  the  initial  link  parameters,  we  come  up  with  the  following 
actuator  sizes, 

rio,mm  ~  2. 13A^/n, 

=  0.\5Nm.  (2.31) 

Iteration  2. 

Since  we  can  vary  the  actuator  torques  between  0.2  -  5  Nm  using  the  gear  reduction,  the  weight  of 
brushless  motor  is  assumed  to  be  around  1.1  Kg.  Our  manipulator  is  manipulator  type  1  and  we  include 
the  actual  weight  of  actuator  2  to  obtain  a  new  set  of  parameters. 

link  1  ;  /j  =  0.303, ai  =  0.196, mi  =  2.259,/i  =  0.129, 

link  2  :  /2  =  0.254,02  =  0.094,m2  =  1.129,/2  =  0.003.  (2.32) 

If  we  use  equations  (2.9)  and  (2.10)  with  the  new  set  of  link  parameters  in  (2.32),  then  we  come  up  with 
the  following  actuator  sizes, 

flo.min  ~  3.17A^m, 

T^,min  =  0.15/Vm.  (2.33) 

Iteration  3. 

Since  the  weight  of  actuators  is  assumed  to  be  around  1.1  Kg,  we  have  the  manipulator  parameter  set 
in  (2.32).  If  we  use  equations  (2.9)  and  (2.10)  with  the  set  of  link  parameters  in  (2.32),  then  we  come  up 
with  the  same  actuator  sizes  as  in  calculation  2  as  follows, 

“  3.17A/m, 

T5^,n,in  =  0.15/Vm.  (2.34) 
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The  required  actuator  sizes,  therefore,  are  the  values  in  (2.33). 


Case  2:  Design  for  in-motion  acceleration 

Similariy,  using  (2.16)  and  (2.17)  and  employing  the  algorithm  (Figure  7),  we  obtain  the  following 
minimum  actuator  sizes  to  satisfy  the  in-motion  isotropic  acceleration 

3.421Vm, 

r?y.m;n  =  0.171Vm.  (2.35) 

As  expected,  because  of  the  non-linear  effects  when  the  manipulator  is  “in-motion”,  results  (2.35)  show 
that  we  should  use  bigger  actuators  in  order  to  achieve  the  same  level  of  acceleration  properties  as  in 
manipulator  start-up. 

Case  3:  Design  for  local  acceleration 

Using  (2.23)  and  (2.24)  and  employing  the  algorithm,  in  Figure  7,  we  obtain  the  minimum  actuator 
sizes  to  satisfy  the  local  isotropic  acceleration 

*  4. 12A^/n, 

=  O.MNm.  (2.36) 

As  expected,  we  come  up  with  the  bigger  aauator  sizes  in  (2.36)  than  those  of  the  “in-motion”  results  in 
(2.35). 
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Figure  8:  Mechanical  components  of  a  two  degiee-of-freedom  manipulator 

6  Experimental  verification 

In  this  section,  we  describe  simple  experiments  which  aie  used  to  determine  the  acceleration  set  Sr 
(Start-up  acceleration  capability)  and  then  compare  the  experimental  results  with  those  obtained  using  the 
analytical  results  of  Part  I. 

6.1  Description  of  the  two  degree-of-freedom  manipulator  experimental  set-up 

The  mechanical  structure  of  the  two  degree-of-freedom  manipulator  is  shown  schematically  in  Figure  8. 
The  design  modular  so  that  the  links  can  be  easily  changed,  thus  allowing  one  to  study  the  effect  of 
changing  the  link  parameters.  Each  link  is  driven  by  a  motor  as  shown  in  the  Figure.  A  schematic  of  the 
control  hardware  which  is  used  to  drive  each  motor,  and  thereby  control  the  torque  applied  to  each  link, 
is  shown  in  Figure  9;  the  main  points  to  note  in  the  control  hardware  are  the  following; 

1.  A  specified  input  torque  commanded  from  a  terminal  (by  the  user)  is  transmitted  to  the  pulse-width- 
modulation  (PWM)  generator  by  the  MC68K  microprocessor  board. 
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Figure  9:  Control  implementation  of  a  two  degree-of-freedom  manipulator 
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2.  The  PAVM  generator  converts  the  torque  command  into  a  pulse  width  modulated  voltage  signal  to 
the  motor  resulting  in  the  application  of  the  torque  to  the  link. 

3.  The  motor  position  is  measured  by  optical  encoders  and  transmitted  to  the  MC68K  microprocessor 
board  where  it  is  stored  until  needed  by  the  host  computer  (for  various  purposes). 

6.2  Experimental  procedure 

We  describe  the  procedure  for  experimentally  determining  Sr.  Because  Sr  is  a  parallelogram  in  the  x  - 
plane  (see  Figure  5),  it  is  sufficient  to  obtain  the  four  vertices  A"  ,  B'  ,C' ,  and  D'  of  Sr  which  correspond, 
respectively,  to  the  vertices  A,  B,  C,  and  D  of  the  torque  set  T  shown  in  Figure  3.  Furthermore,  because  the 
origin  of  the  acceleration  plane  is  the  centroid  of  the  parallelogram  a'b'c" D',  it  is  sufficient  to  determine 
the  vertices  A'  and  B'  which  correspond,  respectively,  to  the  vertices  A  and  B  of  the  torque  set  T. 

If  Tia  and  Tio  denote,  respectively,  the  magnitude  of  the  maximum  actuator  torques  at  joints  1  and  2, 
then 

1.  in  order  to  generate  point  A'  of  St.  we  should  apply  actuator  torques  rjo  and  T2o,  respectively,  at 
Joints  1  and  2,  and 

2.  in  order  to  generate  point  b'  of  Sr.  we  should  apply  actuator  torques  T\t,  and  -r^a,  respectively,  at 
joints  1  and  2. 

The  procedure  to  obtain  the  image  point  in  Sr  (for  example.  A')  corresponding  to  a  point  (n,  rj)  in 
T  (for  example,  .4)  is  as  follows; 

1.  Apply  the  actuator  torques  tj  and  T2  at,  respectively,  joints  1  and  2. 

2.  Measure  the  joint  variables  <71  (r)  and  (72(f)  at  tegular  sampling  instants.  (The  particular  sampling 
time  chosen  was  0.01  second.) 

3.  Obtain  the  second  rates-of-change  of  the  joint  variables  ^i(it),  i=l,2,  at  the  sampling  instant  from 
the  following  finite-difference  equations. 


Table  4:  Comparison  of  experimental  and  calculated  accelerations  for  two  data  points 


where  k,  k+1  and  k+2  denote,  respectively,  the  A:*,  (ifc+  1)*  and  (A +  2)'*’  sampling  instants,  and  At 
is  the  sampling  time. 


4.  Determine  the  required  acceleration  of  /*,  from 


x^  = 


XI 

X2 


(2.38) 


Since 


4^0, 
Xf  a  J^. 


(2.39) 


The  coordinates  Xi  and  X2  obtained  from  the  equation  (2.38)  above  is  the  required  image  point  in  Sr- 
The  following  details  apply  to  the  particular  experiments  which  we  performed: 

1.  The  experiments  were  performed  for  the  configuration  q\  =  0°  and  q2  =  90"; 

2.  The  parameters  for  the  two  links  are  given  in  section  5. 

3.  The  maximum  actuator  torques  applied  were  t\o  =  8.12  Nm  and  =  0.17  Nm,  which  were  in  the 
set  of  actuator  constraints  determined  in  the  previous  section. 


63  Experimental  results 
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Figure  10:  Comparison  of  experimental  (dotted  parallelogram)  and  calculated  (solid 
parallelogram)  start-up  acceleration  capability  of  the  manipulator 

The  experimental  results  for  the  determination  of  the  points  X  and  B'  are  given  in  Table  4  and 
graphically  described  in  Hgures  10.  Also  included  are  the  theoretical  results.  From  Table  4,  we  see  that 
the  experimental  and  theoretical  results  agree  within  experimental  error  (  <  15  %  )  and  arc  certainly  good 
enough  for  our  purposes. 

In  Table  5,  we  compare  the  values  of  the  start-up  acceleration  properties  obu,iu  and  Oifo,m  obtained 
from  experiment  and  theory;  the  theoretical  and  experimental  results  agree  to  within  10  %.  The  results 
of  the  experiment  demonstrate  the  feasibility  of  using  our  theory  to  determine  acceleration  capabilities. 
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Acceleration  properties 

(experiment) 

Acceleration  properties 

(theory) 

Error 

^tmu.su  ~  7.27 

^ax.tu  ~  8.0 

9  % 

^ito.su  ~  3.63 

ttjio.w  ~  3.91 

7  % 

Table  5:  Comparison  of  experimental  and  calculated  acceleration  properties  (m/s^),  (Error 

—  I  floqi  ~  flc«l  I  / flcil) 
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7  Summary  and  conclusions 


Using  the  theory  of  acceleration  sets,  (Desa  and  Kim,  1989),  we  have  defined  0n  section  3)  six 
performance  measures  which  can  be  used  as  a  basis  for  designing  manipulators  for  performance.  We  then 
illustrated  the  usefulness  of  these  performance  measures  by  applying  them  to  the  soluiioo  of  the  following 
two  manipulator  design  problems. 

1.  Selection  of  the  “best”  manipulator  type  from  a  set  of  alternative  manipulator  types 

2.  Detenninaiion  of  minimum  actuator  sizes  to  achieve  desired  isotropic  acceleration. 

An  explicit  procedure  wis  given  in  section  4  to  solve  the  fiist  problem,  viz.  "type  selection".  Algorithms 
for  the  determination  of  actuator  sizes  ate  given  in  section  5. 

Finally  in  section  6,  we  addressed  the  experimental  determination  of  the  maximum  and  isotropic  start-up 
acceleration  and  presented  experimental  results  which  verified  the  theory  for  start-up  acceleration  sets  and 
start-up  acceleration  properties. 
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Appendix.  Equations  of  motion  for  planar  manipulators 
1.  Jacobian  matrix 

The  joint  velocity  is  related  to  the  velocity  in  Cartesian  space  by  the  Jacobian  matrix, 
x  =  jq. 

The  Jacobian  matrix  J  for  the  three  types  of  manipulators  arc  as  foUows; 

Manipulator  type  1: 

-/i  sin  q\  -  h  sin(<7i  +  ^2)  -h  sin(^i  +  qi) 
l\  cos  q\  + 12  cosC^i  +  ^2)  h.  oosiqx  +  qi) 

Manipulator  type  2: 

-/isin^i  -/jsin^2 
l\  cos  q\  Is  cos  q2 
Manipulator  type  3: 

-/isin<7i  -/2  sin  <72 
li  cos  q\  I2  cos  q2 

When  this  relationship  is  differentiated  with  respect  to  the  time,  we  obtain  the  following  equation, 

ii  =  Jq  + Jq  =  Jq- E{q}^  (2.40) 

where  E  is  the  matrix  which  has  the  following  elements: 

Manipulator  1: 

/i  cos  <71  +  h  cos(qi  +  <72)  h  cos(<7i  +  ^2) 
l\  sin  <71  + 12  sin(<7i  +  <72)  I2  sin(<7i  +  ^2) 

Manipulator  2: 

/i  cos  q\  Is  cos  q2 
l\smqi  /s  sin  92 


Manipulator  3: 


/]  cos  q\  I2  cos  qz 
li  sin  qi  I2  sin  qz 


2.  Dynamic  equations 

The  dynamics  of  a  two-degree-of-freedom  planar  manipulator  is  described  by  the  following  equation: 


Dq  +  V{q}2  =  r. 

The  components  of  matrices  D  and  V  are  as  follows: 

Manipulator  1: 

[ /i +/niJ?  +  /2 +  m2(<^  +  2a2/t  cos  ^2  ■»•/?)  h  +  mzit^  +  azhcosqz) 


h  +  rnzidz  +  ozh  cos  ^2) 


I2  +  tnzc^ 


-mzazh  sin  qz 


Tfizozh  sin  qz 


Manipulator  2: 


I\  +  miflf  +  mz({  +  /4  +  I7U<^  (mAOilz  +  mjailOcosCqi  -  qz) 
(171404/2  +  "»3fl3/i )  cos(^i  -  qz)  h  +  +  miz  +  /s  + 


(.miO^Iz*  mzazh) siniqi  -  qz) 


-(mAOAlz  mzazh) sm(q\  -  qz) 


Manipulator  3: 


I\  +  miflj  +  mz(i  mzazh  cos(^i  -  ^2) 
mzazh  cos(<7i  -  qz)  h  +  mzc^ 


mzazh  sin(<7i  -  qz) 


-mzazh  sin(<7i  -  qz) 


The  nonlinear  vector  is  as  follows; 
Manipulator  1: 


(2.41) 


{<i)’  -  ^ 

Wj  ^ 

Manipulator  2: 


Manipulator  3: 


3.  Acceleration  equation 

The  expression  of  the  acceleration  of  the  end-effector  is  as  follows: 
i  =  Ar  +  B{4}^ 

where 

A  =  JD-‘ 

B  =  -AV  -  E 

where  J,  D,  V  and  E  are  given  above  for  each  manipulator  type. 


(2.42) 

(2.43) 

(2.44) 
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